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ABSTRACT 


Adaptive  compliance  control  of  a  single  robotic  joint  was  studied  to  control  the 
amount  of  torque  applied  on  an  object  by  an  end  effector,  which  is  actuated  by  an 
electric  motor  through  a  gearbox. 

For  this  reason,  an  adaptive  control  system  was  designed.  Variation  in  stiflhess  and 
compliance  was  observed  by  simulating  the  system  with  iV/^r/?/A',package  program. 
After  observing  theoretical  variation  of  the  stiffness  and  the  compliance,  experiments 
were  done  to  observe  and  prove  the  stiffness  control  theorv’. 

The  proved  theory  was  then  applied  to  a  robotic  finger  joint  actuated  by  a  small 
DC  motor. 
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I.  INTRODUCTION 


One  of  the  most  important  problems  in  robotics  is  the  design  of  a  dextrous  end 
effector.  A  dextrous  end  effector  is  a  kind  of  gripper  or  a  tool  that  enables  a  robot  to 
hold  or  handle  different  kinds  of  objects  easily  and  skillfully,  like  a  human  being.  Dif¬ 
ferent  techniques  can  be  used  to  give  that  kind  of  ability  to  the  end  effector.  Two  of 
those  techniques  are  direct  drive  and  indirect  drive.  In  indirect  drive,  the  fingers  of  the 
dextrous  end  effector  will  be  driven  by  tendon  cords  which  are  actuated  by  electric  mo¬ 
tors  installed  into  the  arm.  In  direct  drive,  the  fingers  are  actuated  by  electric  motors 
installed  directly  into  the  finger  itself  Unfortunately,  many  actuators  are  best  suited  to 
relatively  high  speed  and  low  torque,  therefore  they  require  a  speed  reduction  system 
which  is  usually  a  gearbox. 

In  today's  automated  machinery,  reliability  is  an  important  factor.  Since  reliability 
decreases  with  increasing  complexity,  it  is  better  to  try  to  keep  the  end  effector  simple 
in  both  its  design  and  function.  The  main  source  of  complexity  in  de.xtrous  hand  design 
comes  from  the  finger  joints.  In  Figure  1,  tendon  cord  controlled  dextrous  end  effector 
is  shown.  As  can  be  seen  from  the  figure,  pulleys  and  the  tendrn  cords  used  to  actuate 
the  fingers  presents  a  considerable  amount  of  complexity. 

In  a  tendon  cord  design,  the  designer  must  consider  the  tension  of  each  tendon,  since 
any  slack  will  cause  a  problem.  After  gripping  an  object,  the  power  on  the  tendon  cords 
must  be  kept  to  maintain  a  grasp  on  the  object.  Another  problem  will  be  the  weight  of 
the  hand.  Since  the  weight  of  the  hand  and  the  arm  is  increased  by  a  tendon  cord  and 
pulley  system,  this  will  cause  problem  in  arm  joint  (elbow)  and  shoulder  joint  designs. 

By  using  a  direct  drive  method  in  the  finger  joints,  the  difficulties  listed  above  can 
be  overcome  to  some  extent.  By  installing  DC  servo  motors  directly  to  the  finger  joints 
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Figure  1.  Iciulun  Cord  Controlled  F.iid  Effector. 


as  shown  in  I'igiiic  2,  the  linger  links  can  be  moved  without  tendons.  I  he  weight  and 
keeping  the  power  on  after  tlic  giip  will  not  be  a  problem.  If  the  motor  drives  the  joint 
through  a  high  ratio  gearbo.x,  power  may  be  removed  /join  the  motor,  and  the  small 
amount  of  armature  friction  will  prevent  the  motor  horn  being  backdriven.  '1  his  means 
that  a  grasp  is  maintained  with  power  removed.  Since  the  complexity  of  the  joint  will 
be  less,  the  reliability  of  the  system  will  be  higher,  by  using  a  gearbox  to  transmit  the 
motor  torciuc  and  insttilling  the  actuators  directly  into  the  finger,  this  system  provides 
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torque  multiplication  and  increased  position  resolution  which  are  very  critical  properties 
in  the  successful  design  of  robot  joints. 

Although  having  a  joint  nonbackdriveablc  is  an  advantage,  there  are  disadvantages, 
for  example  in  handling  delicate  objects  where  a  relatively  large  compliance  in  the  finger 
joint  is  desirable. 

In  a  finger  joint  a  direct  drive  element  must  therefore  carry  out  two  tasks.  1.  It 
should  be  able  to  bring  the  joint  to  the  desired  position,  and  2.  after  contact  with  an 
object  it  must  provide  enough  grip  to  hold  or  to  manipulate  the  object  without  breaking 
it. 

Therefore  our  system  must  have  two  characteristics.  It  must  provide  position  control 
and  necessaiy  torque  without  breaking  the  object.  While  position  control  is  enough  to 
provide  a  desired  trajectory,  when  contact  is  made  between  the  end  efiector  and  the  ob¬ 
ject.  position  control  may  not  be  sufficient. 

Contact  force  applied  on  an  object  will  be  the  major  problem  with  the  direct  drive 
end  elTector.  The  contact  force  applied  by  a  direct  drive  end  effector  on  an  object  will 
be  decided  by  the  stilfness  of  the  servomechanism  used  to  actuate  the  joint.  Usually 
servomechanisms  have  high  natural  stiffness  due  to  the  high  gear  ratio.  This  may  cause 
some  problems  when  manipulating  fragile  objects.  This  problem  may  be  overcome  by 
changing  the  stifl'ncss  of  the  system  for  certain  tasks.  Stiffness  of  the  servo  system  will 
be  defined  as 


Where  =  the  disturbance  torque  applied  to  the  output  shaft  and  0,  =  the  angular 
displacement  of  the  output  shaft.  By  changing  the  stiffness  of  the  system,  torque  applied 
on  the  object  can  be  controlled.  The  inverse  of  stiffness,  namely 
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Figure  2.  Direct  Drive  End  Effector 


(1.2) 


will  be  defined  as  compliance  of  the  sysicin. 

The  purpose  of  this  research  is  to  design  a  simple  system  that  will  provide  both  po¬ 
sition  control  and  torque  control,  and  by  changing  the  stiffness  of  the  servo  system  to 
be  able  to  control  the  applied  torque  on  the  grasped  object. 
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The  thesis  consists  of  eight  chapters.  Following  the  introduction,  chapter  2  presents 
the  theory  of  stiffness  and  compliance  control.  The  third  chapter  is  devoted  to  system 
parameter  identification  of  the  experimental  system.  Simulation  results  of  system  re¬ 
sponse  are  presented  in  chapter  four.  The  fifth  chapter  is  devoted  to  experimental 
stiffness  control  of  the  system  while  chapter  six  discusses  the  adaptation  of  stiffness 
control  to  a  prototype  finger  configuration.  Following  the  discussion  chapter,  conclu¬ 
sions  are  presented. 
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II.  THEORY  OF  STIFFNESS  AND  COMPLIANCE  CONTROL 


Interaction  between  objects  and  the  end  efrcctor  presents  a  much  more  complicated 
problem  than  position  control.  When  an  end  elTector  is  moving  in  a  free  space,  there 
isn't  any  constraint,  namely  it  does  not  touch  any  object  that's  going  to  constrain  its 
motion.  When  it  has  contact  with  an  object,  a  new  variable  defined  as  a  disturbance 
must  be  added  to  the  system. 

A.  POSITION  CONTROL  SYSTEM  AND  STIFFNESS  OF  A  SYSTEM 
1.  Standard  Position  Control  system: 

1  he  object  in  a  position  control  system  is  to  control  the  angular  position  of  the 
output  shaft.  The  desired  position  of  the  output  shaft  is  achieved  by  a  voltage  that  has 
been  generated  by  means  of  a  potentiometer,  as  shown  in  the  block  diagram  in 
Figure  3.  The  angular  position  (0,)  of  the  potentiometer  generates  a  proportional  bipolar 
voltage  according  to  the  potentiometer's  transfer  function  (  ,volts;radian).  Ihis 
voltage  is  compared  to  the  achieved  position  of  the  load  or  output  shaft  of  the  motor 
as  measured  by  another  identical  potentiometer.  An  error  voltage  is  generated  by  sum¬ 
ming  these  two  voltages.  Usually  after  passing  through  an  amplifier,  this  voltage  drives 
the  motor.  This  amplifier's  gain  is  usually  called  the  forward  path  gain  of  the  system 
(k,).  The  angular  velocity  of  the  motor  shaft  is  obtained  after  the  applied  voltage  is 
passed  through  the  motor.  Following  the  motor,  there  is  usually  a  gear  box.  Dividing 
motor  shaft's  angular  velocity  by  the  gear  ratio,  the  angular  velocity  of  the  motor's 
output  shaft  velocity  is  obtained.  Since  differentiation  of  the  position  gives  the  velocity, 
by  integrating  the  angular  velocity,  angular  displacement  of  the  output  shaft  can  be  ob¬ 
tained.  This  angular  displacement  of  the  output  shaft  is  fed  back  to  the  system  to  achieve 
desired  position. 
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In  the  block  diagram  following  constants  are  used. 

K,  =  Motor  constant  (rad  sec,  volt) 

Potentiometer  constant  (volt  rad) 
r„=  Mechanical  time  constant  (sec) 
k,  =  Forward  path  gain 
N  =  Gear  ratio 

In  position  control  systems,  different  kinds  of  electrical  motors  can  be  used, 
although  a  DC  motor  has  been  used  in  this  research.  The  DC  motor  is  a  power  actuator 
device  that  delivers  energy  to  a  load.  DC  motors  rotate  due  to  the  interaction  of  two 
magnetic  fields,  one  in  the  stator,  one  in  the  rotor.  The  rotational  speed  may  be  varied 
by  controlling  the  strength  of  one  of  these  fields.  The  input  voltage  can  be  applied  to 
either  the  field  or  the  armature  terminals.  The  air-gap  flu.x  of  the  field  current  is  pro¬ 
portional  to  the  field  current.  So  that 


<f>  =  % 


(2.1) 


Kf  =  Field  constant 
if  =  Field  current 

The  torque  developed  by  the  motor  is  assumed  to  be  related  linearly  to  0  and 
the  armature  current  as  follows 

T^  =  Ky<t>iJ^t)  =  K,Kjij{i)i,{^  (2.2) 


T„  =  .Motor  torque 
=  Armature  current 
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In  order  lo  have  a  linear  clement  one  current  must  be  maintained  constant 
while  the  other  current  becomes  the  input  current.  Two  kinds  of  motor  can  be  defined 
based  on  this  principle,  field  controlled  motor  and  armature  controlled  dc  motor,  as 
shown  in  Figure  4.  By  taking  Laplace,  transform  of  equation  (2.2)  the  following 
equation  is  obtained. 


T„,(s)  =  (A',  A>4);/.v)  =  Kjlp)  (2.3) 

Where  AV  =  .Motor  constant  (Nm'amp) 

The  field  current  is  related  to  the  field  voltage  as 

Vp)^{Rf+LfS)Ij(s).  (2.4) 


I  /  =  Field  voltage 
Lf  =  Field  inductance 

The  motor  torque  is  equal  to  the  torque  delivered  to  the  load.  This  relation  may 
be  expressed  as 


T„,(5)  =  TJs)  +  T^s), 


(2.S) 


Ti  =  Load  torque. 

Trf  =  Disturbance  torque. 

The  load  torque  for  rotating  the  inertia  shown  in  Figure  4  is  written  as 

T^(.s)  =  Js^O(s)  +fsO(s).  (2.6) 
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Figure  4.  A  DC  Mulor  a)  Wiring  Dingrain  b)  Sketclu 


Kcarraiigiiig  ciiuations  (2.3),  (2.4)  and  (2.5).  the  follouing  equations  niay  be 
obtained, 


1 

(! 

<< 

(2.7) 

(2.8) 

(2.9) 

'i  hercforc,  (he  transfer  function  of  the  motor-load  combination  will  be  as  (bl- 


(2.10) 


II. 

JLf 

7  W~ 

5(5  +  '7  )(^  +  7^ ) 

The  block  diagram  of  the  field  controlled  dc  motor  is  shown  in  Figure  5. 
Alternatively,  the  transfer  function  may  be  written  in  terms  of  the  time  con¬ 
stants  of  the  motor  as 


0(  s)  fi^f 

Iy{.s)  ~  5(Ty5+  l)(T^.S-fl) 


(2.11) 


L,  j 

where  and  ~ 


Since  usually  the  field  time  constant  may  be  neglected. 

The  armature  controlled  dc  motor  utilizes  a  constant  field  current,  therefore  the 
motor  torque  may  be  written  as  by 


T„{s)  =  {K,KfIj)Us)^Krla{s). 


(2.12) 


The  armature  current  is  related  to  the  input  voltage  applied  to  the  armature 
by 


F;(5)  =  iRa+  LaS)^s)  -f  F^(s), 


(2.13) 


where  ^^(.s)  is  the  back  electromotive-force  voltage  proportional  to  the  motor  speed. 

r,(s)  =  ^>(.9),  (2.14) 

hence 
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Figure  5.  Block  Diagram  of  Field  Controlled  DC  Motor. 


r/c)-A>>(.o 


(2.15) 


The  same  load  torque  equations,  (2.6),  (2.7)  will  be  valid  for  armature  control 
also.  The  relations  for  the  armature  controlled  dc  motor  are  shown  in  the  Figure  6. 
The  transfer  function  of  armature  controlled  dc  motor  will  be  as  follows 

Q(5)  _ _ ^ _ 

'  5[(/^,  +  L„s){Js  +y)  +  A',AV]  ■ 

For  many  dc  motors,  the  time  constant  of  the  armature,  t. 

The  resultant  transfer  function  will  be  as  follows 


(2.16) 

=  is  negligible. 


[ - lH - ] 

f„(.s)  .\(r,.s+l) 


where  the  time  constant  t,  =  .  „  ..  . . 


(2.17) 
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Figure  6.  Block  Diagram  of  Armature  CoiilroIIcd  DC  Motor. 

2.  Effect  of  load  inertia: 

A  study  of  the  free  body  diagram  of  the  motor,  gearbox  and  tlie  load  will  be 
helpful  to  write  the  equation  motion  of  the  mechanical  part  of  the  dc  motor  in 
Figure  7. 

Since  the  armature  inertia  and  the  viscose  friction  have  to  be  overcome,  all  of 
the  torque  generated  (t„)  is  not  available  at  the  gearbox  input  shaft.  The  general 
equation  of  motion  of  a  torque  generating  system  may  be  written  as 


=  (2.18) 

Considering  the  gearbox  ratio  N>  1  the  equation  of  the  motion  can  be  written  as  follows 
For  the  motor  shal't 
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Figure  7.  Free  Body  Dingraiii  of  DC  Motor. 


For  tlic  load  sliaft 


For  the  gearbox 


c,w, 


(2.19«) 


T2  —  C1M2  — 


{2.19b) 
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T2  =  A't, 


(2.19c) 


0)2=  — 


T„  =  Motor  torque 
=  Armature  inertia 
=  Load  inertia 

0)1  =  Motor  shaft  angular  acceleration 

o)i  =  Motor  shaft  angular  velocity 

0J2  =  Output  shaft  angular  acceleration 

(i)2  =  Output  shaft  angular  velocity 

Cl  =  Motor  shaft  damping 

Cl  -  Output  shaft  damping 

Referring  all  variables  to  the  motor  shaft  gives: 


•^2 

Tm  Y 

(2.20) 

J/Ct)2 

(2.21) 

Y  ^ 

S 

J  ^*'^1 

C-.U)\ 

(2.22) 

2  ~  ~ 

A2 

R.esulting  in  the  final  equation 

J,  C3 

\  *•  .\  ^ 


In  the  equation  of  motion  there  is  an  important  property  that  has  to  he  noticed. 
The  efTect  of  tlic  gcarbo.x  reduces  the  load  inertia  and  load  shaft  damping  factor  by  A’. 
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Tills  means  that,  by  using  a  gearbox  we  may  apply  less  torque  to  the  motor  shaft  to 
accelerate  the  load  on  the  output  shaft.  Another  interesting  effect  of  the  equation  can 
be  seen,  when  the  torque  is  applied  to  the  output  shaft  to  turn  input  shaft,  fhen  fol¬ 
lowing  equation  will  apply: 

Tm  =  +  (<^1  (2-24) 

In  this  equation,  the  effect  of  input  shaft  s  inertia  will  increase  by  .  As  a  result  of  this 
effect,  it  will  be  easier  to  turn  the  system  in  the  figure  by  applying  torque  on  input  shaft 
rather  than  on  output  shaft.  This  is  one  of  Uio  important  properties  used  in  control 
systems  design  to  reject  disturbances. 

3.  Analysis  of  the  seno  system: 

Torque  generated  by  the  armature  is  linearly  related  to  the  current  applied. 
Torque  generated  by  the  armature  is  given  by 

Tm  =  (2.25) 


Here  Kj  is  the  motor  torque  constant  with  units  Nm  amp.  I  his  generated  torque  ac¬ 
celerates  the  motor  armature  itself  and  an  external  load.  It  also  overcomes  viscous 
damping  torque  and  any  external  load  torque. 

As  demonstrated,  in  the  preceding  section  of  the  chapter,  the  load  inertia  rather 
than  motor  inertia  may  be  neglected,  if  N  >  >  1.  The  transfer  function  from  motor 
torque  r„  to  output  angular  velocity  is  obtained  by  taking  the  Laplace  transform  of 
equation  (2.24)  and  re-arranging  in  the  form. 


o> _ 1 

^  /v  -I-  c 


(2.26) 
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Where  J  is  the  total  inertia  referred  to  the  motor  shaft  and  c  is  the  total  damping  referred 
to  the  motor  shaft.  Both  the  inechanical  and  electrical  part  of  the  motor  gearbox  com¬ 
bination  can  be  seen  in  Figure  S.  The  complete  position  control  system  block  diagram, 
is  now  shown  in  Figure  9. 

The  close  loop  transfer  function  of  the  system  becomes 

=  .\s(Js  +  c)  ^  ^  (2-27) 


L’sing  (jj„  =  \sd,,  the  transfer  function  of  the  system  can  be  written  as: 


Oi 


K 


./.Vs^  -I-  (c.V  -t-  ki,XR)s  +  K 


(2.28) 


where  K  =  k, — 

4.  Disturbanee  effect  on  the  position  control  system: 

The  main  variable  in  stiffness  and  compliance  control  of  a  servo  mechanism  is 
the  torque  applied  on  the  object.  This  torque  must  be  adjusted  according  to  the  dis¬ 
turbance  torque  sensed  from  the  object.  When  an  end  effector  applies  a  torque  on  the 
object,  the  object  will  apply  a  reaction  torque  on  the  end  effector.  This  will  cause  a  dis¬ 
turbance  effect  on  the  system.  In  Figure  10  a  sketch  of  an  end  effector  applying  torque 
on  an  object  and  the  object's  reaction  torque  are  shown.  This  disturbance  torque  will 
have  a  braking  effect  on  the  output  shaft.  The  analysis  of  the  system  may  proceed  in  the 
same  manner  identical  to  before,  except  that  the  equation  of  the  load  shaft  will  be 
modified  due  to  the  disturbing  torque  Tj. 

Considering  the  disturbance  torque  and  gear  box  effects  as  shown  in 
Figure  11,  the  equation  of  motion  of  the  system  may  be  written  as  follows 
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Yj^i  =  jd.  (2.29) 

/=i 


=  (Ja  +  ~T  +  (<^1  +  "7^  )^n 
A  A 


(2.30) 


An  equation  may  be  written  considering  total  inertia  and  damping  of  the  sys¬ 


tem. 


T 


m 


1± 

N 


=  Jd>„, 


+  C(0^ 


(2.31) 


Trf  =  Disturbance  torque 

(j}„  =  Motor  sliaft  s  angular  acceleration 
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Figure  9. 


Position  Control  System. 
Motor  shaft's  angular  velocity 
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Figure  10.  Free  Body  Diaginin  of  a  Torque  Applying  End  Effector. 

'I  he  equation  of  motion  of  the  system  may  written  as 

+7)  ^  +  W^po>  -^okpo,)) 3  (2.32) 

and  represented  in  block  diagram  form  as  shown  in  f  igure  12. 

1  he  transfer  function  of  the  system  including  a  disturbance  torque  and  keeping 
0,  constant  can  be  written  as  follows 


T<i 


_ ! _ 

2  Ay- 

AVs'  +  {cN  +  A,/\>  + 


(2.33) 


Again  using  (j)„  —  i\s0^,  the  steady  state  response  of  the  system  to  a  disturbance 


torque  js: 


Figure  1 1.  Free  Body  Dhigraiii  of  Motor  Shaft  With  Gear  Box  and  Disturbance. 


Op  _  R 

^^a^pol  ^  T 


(2.34) 


An  indication  of  tlie  system  stiffness  can  be  seen  when  one  tries  to  turn  the 
output  shaft  of  the  system  by  hand.  The  system  will  show  a  resistance  to  the  hand, 
opposite  to  the  desired  rotation.  The  resistance  is  caused  by  the  voltage  generated  by 
tlie  output  shaft's  potentiometer.  As  stated  above,  this  voltage  will  be  fed  back  to  the 
system  as  a  negative  signal,  meaning  that,  the  motor  will  generate  a  torque  opposite  to 
the  torque  applied  to  the  output  shaft  by  the  hand.  I  he  ratio  of  rotation  to  torque, 
given  in  equation  (2.35)  is  the  stiffness  of  the  servo. 
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^a^poi^T 


(2.35) 


_ _ 

eo 

There  are  four  values  which  may  help  to  change  the  system's  stiffness.  These 
can  be  seen  in  equation  (2.35).  In  this  equation  only  A, can  be  changed.  As  k,  increases 
stiffness  of  the  system  will  be  increasing.  AV  *  R  can  not  normally  be  changed,  because 
they  are  particular  values  which  are  fixed  by  the  motor.  Changing  the  value  of  k,  can 
be  considered,  but  it  is  not  going  to  be  a  very  good  option,  since  this  gain  easily  may 
make  the  system  unstable.  For  this  reason,  another  way  of  changing  the  stiffness  must 
be  considered. 

B.  COMPLIANCE  CONTROL  STRATEGY 

1.  Description  of  how  stiffness  may  be  changed: 

Suppose  that  1  Nm.  disturbance  is  applied  to  a  servo  system  and  1  rad.  rotation 
of  the  output  shaft  is  observed.  This  means  that  the  stiffness  of  the  system  is  1  Nm  rad. 
If  a  higher  rotation  is  desired  by  applying  the  same  torque,  the  stiffness  of  the  system 
will  be  lower.  Namely,  instead  of  1  rad.  of  rotation,  for  example,  5  rad.  of  rotation  is 
observed.  Therefore,  the  stifliicss  of  the  system  will  be  0.2  Nm  rad. 

To  be  able  to  control  the  amount  of  torque  applied  on  the  object  after  contact, 
rotation  of  the  output  shaft  must  be  controlled. 

Since  the  voltage  applied  to  the  motor  causes  the  rotation  of  the  output  shaft, 
by  increasing  the  amount  of  voltage  going  to  the  sunaming  junction  before  the  motor, 
rotation  of  the  output  shaft  can  be  increased.  This  will  cause  additional  rotation  of  the 
output  shaft  for  the  same  torque.  Therefore  the  stilfness  will  be  decreased.  The  new 
block  diagram  of  a  system  which  has  variable  stiffness  ability  is  presented  in  Figure  13. 
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The  measured  disturbance  torque  is  fed  back  to  the  sunmiing  junction  before  the 
motor.  By  passing  the  measured  torque  through  a  variable  gain  E,  we  will  be  able  to 
control  the  amount  of  additional  rotation  of  output  shaft. 

I  he  new  equation  of  motion  of  the  system  will  be  as  follows 

^  4-  c)  t  +  l<a(Gil<po,  -dof^pot  “  T<y/r)}  ]  (2.36) 

Keeping  0,  constant,  the  following  transfer  function  of  the  system  can  be  ob¬ 
tained. 


A'7 


A.,- 


NJs  -t-  (cA  -I — ki,,\  ).s  -f  kg 


K-pk 


pci 


R 


Steady  state  output  of  the  system,  assuming  k,  =  1  will  be 


AV 


(2.37) 


(2.38) 


where  E  is  in  volts  Nm. 

2.  Stiffness  as  a  function  of  gain  E. 

To  demonstrate  the  variable  stillness  and  compliance  in  a  servo  system  ,  E  and 
Tj  are  assumed  to  be  positive  in  equations  (2.36),  (2.37),  (2.38).  Thus  the  following 
equations  were  obtained  as  a  transfer  function  of  the  system. 


~d 


Kp 

(£^+l) 


,\7r +  (f,V+-7^A,,V)s  +  *, 


R 


(2.39) 
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(2.40) 


^T^poi 

R 

This  is  defined  as  tlie  compliance  of  the  system.  The  stiffness  is  the  inverse  of  compliance 
as  shown  in  the  following  equation. 


0 


o 


k 


II 

PC,  yj 


Jll 

R 


+  1 


(2.41) 


As  can  be  seen  in  equations  above,  the  only  variable  is  E.  Therefore  by  changing  E,  the 
stiffness  of  the  system  may  be  changed. 

By  giving  and  arbitrart’  values,  the  stiffness  and  the  compliance  curves 
were  plotted,  as  shown  in  Figure  14  and  Figure  15,  The  compliance  of  the  system  will 
be  directly  proportional  to  E.  Since  the  stiffness  of  the  system  is  the  inverse  of  the 
compliance,  the  stillness  of  the  system  will  be  inversely  proportional  to  E.  At  the  same 
time  rotation  of  the  output  shaft  will  be  directly  proportional  to  E.  The  potentiometer 
constant  will  determine  the  slope  of  the  curve.  As  k^.^,  increases,  the  slope  of  the  com¬ 
pliance  curve  will  be  decreasing.  When  E  is  zero,  the  stiffness  of  the  system  will  be 
equal  to  it  s  natural  stiflhess  or  original  stiffness. 

C.  EFFECT  OF  EFFICIENCY  OF  A  GEAR  TRAIN: 

Another  problem  which  has  to  be  discussed,  concerns  the  disturbance  torque.  Ac¬ 
cording  to  the  gear  theory,  as  presented  in  equation  (2.19c).  the  disturbance  applied  to 
output  shaft  has  to  be  divided  by  the  gear  ratio  N  to  refer  it  to  the  motor  shaft. 

Efficiency  of  the  gear  train  is  another  important  effect  which  has  to  be  addressed. 
It  is  defined  as  the  ratio  of  the  output  power  to  the  input  power,  or  the  ratio  of  the  work 
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COMPLIANCE{RAD/NM) 


COMPLIANCE  OF  A  SERVO  MECHANISM 


E(VOLTS/NM) 

Figure  14.  Coiiipliaiice  Variation  of  a  Servo  System. 

output  to  the  work  input  over  the  same  period  of  time.  Tor  an  ideal  mechanism,  it  will 
be  loo  %  or  1.  In  reality,  a  normal  gear  train  will  dis.sipatc  some  of  the  power  which  has 
to  be  transmitted.  CfTiciency  can  be  written  as; 


27 


STIFFNESS(NM/RAD) 


S'i'IFI-’NESS  OF  A  SERVO  MECHANISM 


E(VOi:iS/NM) 


Figure  15.  Stifliiess  Variation  of  a  Servo  System. 


power  out 
power  in 


(2.42) 


In  the  case  of  the  gear  train,  it  has  to  be  restated,  because  there  is  a  gear  train  ratio. 
Tlic  new  equation  will  be  as  following 
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(2.43) 


actual  output  torque  ] 

^  input  torque  N 

The  efTiciency  of  transmission  can  be  determined  by  measuring  the  resulting  torque 
on  the  output  for  static  torques  applied  to  the  input  shaft. 

The  efiiciency  of  any  mechanical  device  will  become  significant  with  robot  end 
effectors  actuated  by  motors  driving  through  high  ratio  gearboxes.  It  is  no  longer  safe 
to  assume  that  the  output  loads  are  reflected  to  the  input  shaft  by  a  function  of  the  gear 
ratio,  since  any  efiiciency  less  than  1  will  increase  the  torque  required  to  accelerate  a 
given  inertial  load  or  overcome  an  external  torque.  It  is  also  important  to  notice  that  the 
efficiency  of  the  gear  train  docs  not  affect  the  actual  transfer  ratio  of  the  gears  in  terms 
of  displacement,  velocity  or  acceleration,  but  greatly  affects  any  torque  related  property. 
Efficiency  is  dependent  on  such  factors  as  the  coupling  ratio,  the  material's  coefficients 
of  friction,  and  the  angle  used  to  define  the  gear  teeth  or  the  depth  of  cut  and  type  of 
threads  for  screws. 

Another  interesting  effect  of  efficiency  is  on  the  gear  train's  backdrivablity. 
Backdrivablity  is  the  ability  of  a  gear  train  to  transmit  the  torque  or  the  disturbance 
that  has  been  applied  on  the  output  shaft  side  of  the  gear  system,  to  the  motor  or  to  the 
torque  source  as  shown  in  Figure  16. 

In  general  as  the  efiiciency  goes  higher,  the  backdrivablity  will  be  higher,  i.e  the 
system  is  more  likely  to  be  backdrivable.  At  the  same  time  a  gear  trains  efficiency  may 
be  different  for  each  side.  For  example  in  the  case  of  worm  gears,  it  will  be  zero  for 
transmission  of  the  torque  from  the  load  to  the  motor.  Sometimes  this  property  is  good 
in  robotics  application,  because  it  will  help  rejection  of  the  disturbance  torque,  which 
may  be  a  gravitational  or  frictional  torque. 
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Figure  t6.  Transition  of  the  Disturbance  Torque  to  the  Motor. 

At  the  same  time,  nonbackclrivablity  will  influence  system  stiflTness,  because  the 


transfer  function  of  the  system  will  change. 

The  new  equation  of  motion  of  the  system  will  be  as  follows 

Oo  =  ^  ^  ^ 

Keeping  6^  constant,  the  following  transfer  function  of  the  system  can  be  obtained. 


T  At-  ^T^^rot 

iXJs^  +  (c/V  +  kti\)s  + 


Steady  state  output  of  the  system,  assutning  k,  =  1  will  be 


Op  _  E 

^pot 


The  stiffness  of  the  system  will  be 


(2.45) 


(2.46) 
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(2.47) 


0 


0 


If  positive  feedback  is  used,  the  system  stiflhess  will  be  positive  infinite  when  IE  goes  to 
zero.  As  E  is  increased,  the  stiflhess  of  the  system  will  decrease  as  shown  in  Figure  17 
and  Figure  IS. 

The  effects  mentioned  above  must  be  considered  in  our  model  in  order  to  obtain 
high  accuracy.  Therefore  as  one  can  sec  from  Figure  19,  two  new  variables  are  added 
to  the  system.  These  arc: 

K  =  Nonbackdriveability  constant 
»/  =  Efficiency  of  the  gear  train 

Where,  K  =  0  (nonbackdriveablc) 
or  K  =  1  (backdrivcablc) 

for  backdcriveable  systems.  Again  keeping  B,  constant,  the  new  transfer  function, 
compliance  and  stiffness  of  the  system  will  be  as  follows 


Kt 

(£-7^  + 


'jJL 

S' 


SJs  +  (c.V  +  /<[,S)s  +  kg 


AVv 


poi 


R 


Kt 

(i-f + 


Kj-kpor 

R 


^  Kpo,  p 

Op  ~  r-  flfi 
R  S' 


(2,48) 


(2.49) 


(2.50) 
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riglire  17.  Stiffness  N  ai  wtion  of  a  Servo  System  (nonl)ack(liiveal)le). 

riic  imporuuit  conclusion  drawn  from  ihc  above  discussion  is  that  the  system  may 
have  a  finite  stilliiess  by  using  disturbance  feedback  througli  1:  even  thougli  the  original 
svstem  was  not  backdrivcablc.  corresponding  to  inlinitc  stiffness. 


COMPLIANCE(RAD/NM) 


Figure  IS.  CoinpliiiiKe  Vaiialioii  of  a  Seno  System  (iionbackdiiveable). 


Figure  19.  Fosiliun  C'onliol  .Syslciii  lucludiiig  Kfliciencj  and  Jlackdrivaliilily. 


III.  SYSTEM  PARAMETER  IDENTIFICATION 


Electric  motors  used  with  end  elFectors  or  robotic  finger  joints,  are  usually  small 
motors,  hence,  it  is  difiicult  to  ohser%e  the  variation  in  the  compliance  and  the  stifliicss 
of  these  kind  of  systems.  It  is  also  difficult  to  measure  certain  parameters  exper¬ 
imentally,  therefore,  a  larger  servo  system  was  used  to  observe  and  to  prove  compliance 
theory. 

A  feedback  ESI51  educational  servo  system,  together  with  suitable  test  equipment 
was  used  to  prove  compliance  and  stiffness  theory.  Ihis  is  a  high  quality  electro¬ 
mechanical  servomechanism,  consisting  of  three  basic  units:  actuator  unit,  educational 
servo  unit  and  accessories  and  spare  parts  as  shown  in  Figure  20. 

The  actuator  unit  is  essentially  a  24  v  electric  motor  unit,  a  tachogenerator,  gear 
box,  output  disc  and  a  potentiometer. 

The  educational  servo  unit  is  the  control  unit  of  the  system.  It  contains  all  the  nec¬ 
essary  power  supplies  for  the  system  to  operate.  The  main  parts  of  this  unit  are  com¬ 
mand  input,  control  circuits,  preamplifier,  servo  amplifier,  schematic  of  the  actuator 
unit,  current  meter  and  on  off  switch  as  shown  in  figure  2 1 . 

The  ES151  educational  system  is  built  for  standard  position  control.  The  block  di¬ 
agram  of  the  general  system  as  a  standard  position  control  system  is  shown  in 
Figure  22,  As  can  be  seen  from  the  block  diagram  after,  applying  a  voltage  to  the  mo¬ 
tor,  an  angular  velocity  of  the  motor  shaft  is  obtained.  Dividing  motor  shaft  s  angular 
velocity  by  the  gear  ratio,  the  output  shaft  angular  velocity  is  obtained.  Integration  of 
this  angular  velocity  gives  position  of  the  output  shaft.  Voltage  obtained  by  using  an¬ 
other  potentiometer  attached  to  the  output  shaft,  fed  back  to  the  system  as  a  negative 
signal.  The  sum  of  two  voltages  gives  an  error  voltage  which  drives  the  motor.  I  hially 
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Figure  21.  Educational  Sei^o  Unit. 


the  output  shaft  angular  displacement  will  be  the  same  as  input  displacement  introduced 
to  the  system  by  using  command  input. 

In  the  block  diagram  the  following  constants  are  used. 

K,=  Motor  constant  (rad;scc/volt) 

Potentiometer  constant  (volt/rad) 

A'»=  Back  entf  constant  (volt, 'rad; sec) 

T„=  Mechanical  time  constant  (sec) 
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k,=  Control  amplifier  constant  (forward  path  gain,  servo  amplifier  gain) 

A,  =  Power  amplifier  constant 

The  main  difierence  between  this  diagram  and  the  standard  position  control  system 
diagram,  which  was  presented  in  chapter  2.  is  A,.  This  constant  gain  is  added  to  the 
system  to  increase  the  voltage  going  to  the  motor.  It  amplifies  the  potentiometer's  out¬ 
put  voltage  and  matching  it  to  the  DC  motor.  The  procedure  for  finding  these  constants 
e.xperimentally  is  a  standard  laboratory  exercise  (.ME  3802)  and  presented  in  appendix 
A.  Estimated  values  of  these  parameters  are  as  follows 
A'  =  270  rad  sec  volt  (  when  A„  =  0.7) 

A,  =  A'i  =  0.11022  volts  rpm 
^■,c.-=5.7  volts  rad. 

T„  =  0.25  sec.  (open  loop  time  constant) 
and  0  <  A„  <  1 . 

As  stated  at  the  beginning  of  the  chapter,  the  main  reason  for  using  this  system  is 
to  experimentally  prove  the  compliance  and  stiffness  theory  previously  discussed.  The 
block  diagram  for  the  ESI 51  system  is  somewhat  different  from  that  used  in  the  devel¬ 
opment  of  the  theory  of  variable  compliance  -  see  Figure  22  and  Figure  23.  For  this 
reason,  conversion  of  the  identified  parameters  to  those  necessary  to  determine  the 
stiffness  are  necessary.  The  following  equations  indicate  the  equivalence  of  the  parame¬ 
ters.  As  can  be  seen  from  the  figures,  a  new  variable  A^  is  added  to  the  both  systems, 
in  order  to  match  educational  systems  block  diagram  with  position  control  systems 
block  diagram. 


1  r„,v 


(3.1) 


Therefore, 
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(3.2) 


./ 


c 


&  a; 


Ay 

Ac  • 


A’;-=  Motor  torque  constant  (Nm'Amp) 

R  =  Resistance  (ohm) 

J  =  Total  inertia  (Nm  sec**2,'rad) 
c  =  Total  damping  (Nm  sec  rad) 

In  equation  (3.1)  and  (3.2),  the  value  of  T„  and  A,  are  known.  Therefore,  the  value 
of  c  can  be  found  after  finding  the  value  of  J.  The  value  of  J  may  be  found  by  performing 
a  torsional  pendulum  experiment. 

1.  Torsional  pendulum  experiment: 

This  experiment  requires  a  collet,  a  piece  of  wire  with  known  modulus  of  ri¬ 
gidity  and  a  stop  watch.  The  armature  of  the  motor  is  taken  out  and  attached  to  the  wire 
by  way  of  the  collet.  Then  the  wire  is  attached  to  a  fixed  support  where  armature's  free 
movement  can  be  observed,  as  shown  in  Figure  24.  A  half  twist  is  given  to  the  armature 
and  allowed  to  oscillate  freely.  The  equation  of  motion  of  the  system  will  be  as  follows 

Jd  +  K0  =  0  (3.3) 

J  =  Moment  of  inertia  of  the  armature. 

K  =  Torsional  stilfness  of  the  wire. 

The  angular  frequency  of  the  system  will  be  as  follows 

w  =  ^/-^  (3.4) 


(o  =  Angular  frequency  of  the  system. 
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7  lien,  J  =  -^. 

ay 

To  find  the  angular  frequency  of  the  system,  time  was  recorded  for  ten  oscil¬ 
lation  of  the  armature.  Dividing  the  time  by  number  of  oscillation  gave  the  period  of  the 
motion  in  sec  cycle.  Then,  it  was  converted  into  angular  frequency  in  rad'sec.  The 
stilTness  of  the  wire  was  calculated  by  using  following  formulas. 


T  _  GI 

e  i 


(3.5) 


Where  I  = 


Graf 
32/  ■ 


G  =  Modulus  of  rigidity. 

1  =  Length  of  the  wire, 
d  =  Diameter  of  the  wire. 

T  =  Torque. 

The  measured  dimensions  and  properties  of  the  wire  were: 
d  =  2.54E-4  m  1=  0.61595  m 
G  =  40  Gpa. 

The  following  results  were  obtained: 

o)  =  1.239 raif I  sec  &  K=  ~  =  2.65E  —  SNmIrad. 

1  1  1-.^  r-  r  .VW  SCC- 

So,  y=  1.726£-  5 - ; — 

rad 

Since,  J  is  now  known,  the  value  of  c  can  be  calculated  by  using  following 
equation. 


./  _  1.726jr-5  .  .Vmsec 

T„.  0.25  rad. 


(3.5) 


After  finding  the  value  of  c,  the  only  unknown  will  be  i~^)-  This  value  may  be 
found  by  performing  a  speed-torque  experiment. 
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Figure  24.  Torsional  Pendulum. 


2.  Speed-Torque  Experiment: 

When  a  constant  voltage  is  applied  to  the  motor  terminals,  the  motor  shaft  will 
accelerate  and  attain  a  final  steady  state  velocity.  This  may  be  explained  mathematically 
by  using  open  loop  block  diagram  of  the  position  control  system  in  Figure  25. 

The  equation  of  motion  of  the  system  will  be  as  follows 

=  +  (3-«) 

Steady  state  response  of  the  system  into  a  step  input  as  disturbance  with  con¬ 
stant  F,  will  be 
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(3.7) 


fa). 


=  c 


-T, 


A 

R 


kb 

c+Kri- 


Assuming  — - — 
K 


ct)> 


=  [ 


(.V 


A^^^ 


kr,k„ 


(3.8) 


In  equation  (3.8)  the  value  of  Tj<0  and  I' =  a  constant.  This  equation  is 
an  equation  of  a  straight  line,  which  may  be  written  as 


Y^-mX+  C 


(3.9) 


Here,  m  is  the  slope  of  the  curve  and  is  equal  to  { 


J 


). 


C  equals  to  {1]—. — ).  The  onlv  variable  in  equation  (3.8)  is  Tj  Since  the  value  of  <  0, 
this  curve  will  have  a  negative  slope.  When  a  constant  V,  applied  to  the  terminals  of  the 
motor  without  a  braking  or  disturbance  torque,  (o„  without  load  will  be  obtained  and  is 

kA 

known  as  the  no-load  speed.  This  point  will  be  X  =  0  &  =  V',  — — .  W'hen  the 

ki, 

braking  or  disturbance  torque  applies  enough  torque  to  stop  the  motor,  (-mX)  will 
equal  to  C.  This  point  will  be  Y  =  0  &  X  =  t,,  on  the  curve  and  is  known  as  the  stall 
torque  of  the  motor.  This  curve  is  shown  in  Figure  26.  Since  two  points  are  known,  the 

line  can  be  drawn.  To  get  necessary  data,  the  following  procedure  may  be  carried  out. 

1.  Establish  a  constant  voltage,  1'. 

2.  Calculate  the  value  of  k^&.k,. 

3.  From  no-load  speed  calculate  A*. 
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4.  From  slope  calculate 


h. 

R 


However,  the  braking  torque  can  not  be  applied  directly  to  the  output  shaft  in 
the  educational  system,  because  of  the  gear  box  has  a  worm  gear  in  it.  As  discussed  in 
chapter  2.  this  means  that  system  is  nonbackdriveable  and  the  motor  can  not  be  stopped 
by  applying  the  braking  torque  directly  to  the  output  shaft.  That's  why.  the  braking 
torque  is  applied  to  the  motor  shaft,  so  the  value  of  .V'  becomes  1  and  the  speed  torque 
test  is  performed  on  the  motor  shaft,  rather  than  on  the  output  shaft. 

After  establishing  a  constant  angular  velocity.  V,  was  measured  and  found  to 
be  0.43  volts. 

Before  applying  the  voltage  to  the  dc  motor  there  are  two  ampliliers.  As  stated 
above  these  are  controller  amplilier  and  power  amplilier  as  shown  in  Figure  27.  To  find 
k^,  F,  and  F,  voltages  are  measured,  llie  ratio  of  these  two  voltages,  namely  -jt-  gives 
k,.  After  measuring  F„.  the  ratio  of -p-  will  give  k^. 


From  the  ratio  of  ( ^  "  ),  the  value  of  A*  may  be  calculated.  Where,  F„  is  the 
input  voltage  to  the  motor  and  a)f,i  is  angular  velocity  of  the  motor  shaft  under  no-load 
conditions. 

Braking  torque  is  applied  to  the  motor  shaft  by  attaching  a  torque  lever  arm  to 
the  motor  shaft.  A  scale  was  put  under  this  arm  to  measure  the  braking  torque  applied 
to  the  motor  shaft.  When  the  angular  velocity  of  the  motor  shaft  was  zero,  the  scale 
showed  40  grams.  The  braking  torque  was  found  to  be 


Tj=»X  (3.10) 

Where,  W  =  (40,  lOOOjkg  *  (9.81  0.3924  N  (lifted  weight)  and  L  =  0.224 

m.(lcngth  of  the  arm).  After  multiplying  W  by  L,  the  value  of  was  found.  Then,  the 
value  of  and  w.vi.  w  ere  plotted  on  the  speed  torque  diagram.  The  results  of  the  exper¬ 
iment  may  be  summarized  as  follows 
Measured  data: 

Vi  =  0.43  volts 
F,  =  0.206  volts 
F„  =  8.45  volts 
Derived  data: 
k,  =  (0.206  0.43)  =  0.48 
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0.000  Trf 


DISTUHHANCE  TORQUE  (NM) 


rigiiie  26.  Spccd-Toique  Curve. 


/<,  =  (8.45/0.206)=  41 

/<j  =  (8.45/5041  )volts/rpm=  1.67I>3(volts/rpin) 
llciicc  finally 

=  0.01  /V/n/v<7//5 

/<  m/<|y 

1  lie  experimental  speed, 'torque  curve  for  the  motor  is  sliowii  in  I'igure 
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Figure  27.  Pouor  and  Control  Aniplitiei  Clock  Diagram 

Now  that  all  paianieters  in  the  block  diagram  in  Figure  23  have  been  identified, 
the  system  may  be  simulated  in  order  to  observe  its  steady  state  and  transient  response. 
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ANGULAR  VELOCITY(RPM) 


IV.  COMPUTER  SIMULATIONS 


Before  performing  experiments  on  the  model,  variation  of  the  stiffness  and  com¬ 
pliance  were  observed  by  simulating  the  system  with  the  MATRIX,  package  program. 
Also,  the  system  response  »o  diHerent  kinds  of  inputs  and  the  resulting  transient  re¬ 
sponse  were  observed. 

As  stated  in  Chapter  111,  the  ES151  educational  system  has  a  worm  gear  in  the 
gearbox,  therefore  the  natural  stiffness  of  the  system  was  infinite.  This  means  that,  ro¬ 
tating  the  output  shaft  by  using  a  disturbance  torque,  without  feedback  from  the  dis¬ 
turbance  torque,  was  impossible.  But  this  does  not  mean  that  motor  shaft  also  has 
infinite  stiffness.  The  following  equations  may  give  a  better  view  of  this  situation. 


oo. 


(4.1) 


since,  =  0 
However, 


a;.  =  -^#00  (4.2) 

and  therefore  it  is  which  will  be  simulated. 

K,  -  system  output  stiffness. 

A'„  =  motor  shaft  stillness. 

0„  =  motor  shaft  angular  displacement. 

=  output  shaft  angular  displacement. 

Since,  the  disturbance  torque  is  applied  directly  to  the  motor  shaft,  the  gear  ratio, 
the  efficiency  and  backdciivcablity  constant  will  all  be  unity.  The  system  block  diagram 
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with  gear  ratio  equals  to  one,  including  the  parameters  found  in  Chapter  111,  without 
feedback  from  the  disturbance  torque  is  shown  in  f  igure  29. 

As  can  be  seen  from  the  block  diagram,  a  step  disturbance  was  applie  directly  to  the 
motor  shaft,  and  9,  is  assumed  to  be  constant. 

I  he  system  step  response  is  shown  in  Figure  30  {.f  <  1).  Figure  31  (;  >  1).  and  is 
seen  to  be  that  of  a  second  order  system. 

Using  the  following  formulas  system  characteristics  may  be  found  in  terms  of : 

P.O.  =  Percent  overshoot 
=  Peak  time 
^  =  Damping  ratio 
r,  =  Settling  time. 


(-1.3) 


P.O.  =  lOOe  7-7, 

l-s 


(4.4) 


(4.5) 


The  transfer  function  of  the  system  including  the  disturbance  torque,  and  keeping 
6,  constant  can  be  written  as  follows 


_ 1 _ 

^  .  ■>  ^7'  -  ^T^tot 

+  (c.\  +  kf.y,)s  +  kgk^  — — 


(4.6) 
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COMPLIONCE  OF  THE  MOTOR  SHAFT  VS  TIME 


Figure  30.  Step  Response  of  the  Motor  Shaft,  ^  <  I  . 

Again  using  (o„  =  NsO,,  the  steady  state  response  of  the  system  to  a  disturbance 


torque  is: 


Y(t) 


Figure  31.  Step  Response  of  the  Motor  Shaft,  >  1  . 


So,  the  stifTness  of  tlic  system  will  be 


0. 


^a^p^pol^J 

R 


(4.8) 
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Equation  (4.6)  may  be  approximated  into  the  form  of  a  regular  second  order  transfer 


function,  i.e. 


<o„ 


2  2 
S  -h  2CiO^S -h  (0^ 


(4.9) 


To  be  able  to  get  an  ideal  transient  response,  the  damping  ratio  of  the  system  must 
be  adjusted.  Having  a  P.O.  close  to  0  will  provide  the  ideal  transient  response.  For  this 
reason,  ^  or  co„  (natural  frequency  of  the  system)  must  be  changed.  The  only  variable 
in  the  system  which  can  be  effective  in  optimizing  these  values  is  As  can  be  seen  in 
equation  (4.6).  this  value  also  effects  the  stilfness.  To  be  able  to  obtain  the  optimum 
gain  of  for  ideal  transient  response  and  observe  it  is  effect  on  the  stilfness,  the  system 
was  simulated  with  different  values  of  A:„.  It  was  observed  that  when  0.87  <  /c„  <  0.91,  the 
system  had  the  ideal  transient  response  as  shown  in  Figure  31.  The  system  response  is 
presented  in  the  form  of  compliance  and  as  can  be  seen  from  the  figure  the  steady  state 
response  of  the  system  was  as  predicted  in  equation  (4.7).  But,  it  must  be  noticed  that 
simulation  gives  us  the  compliance  as  measured  at  the  output  shaft,  not  the  motor  shaft, 
therefore,  the  result  must  be  multiplied  by  the  gear  ratio  which  is  30  in  this  case.  The 
inverse  of  this  value  gives  the  stilfness  of  the  motor  shaft. 


a- 


-XR 

^a^p^pot^  T 


(4.10) 


where,  = 

Before  designing  and  putting  together  the  necessar\-  experimental  system,  the  effect 
of  the  gain  E  on  the  system  transient  response  must  be  determined,  therefore,  the  torque 
feedback  as  presented  in  the  theory  section  was  added  to  the  system.  After  adding  this 
feedback,  the  system  stiffness  may  be  changed  from  infinity  to  a  finite  value.  Since,  the 
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II 


system  is  nonbackdiriveable,  K  is  equal  to  zero,  l  lie  complete  system,  with  E=  1  and 
K  =  0  is  as  shown  in  Figure  32. 

The  system  was  simulated  by  varying  the  gain  E.  It  was  observed  that  adding  the 
torque  feedback  and  changing  the  values  of  the  gain  E  did  not  effect  the  transient  re¬ 
sponse  of  the  system.  It  was  also  observed  that  the  variation  of  stiffness  and  the  com¬ 
pliance  was  as  predicted  earlier  in  the  theory  section.  To  be  able  to  observe  the  effect 
of  backdriveablity,  the  system  was  simulated  with  K  =  I  and  efficiency  equals  to  0.95. 
These  did  not  effect  the  transient  response  of  the  system  either. 

As  a  result,  by  changing  the  value  of  A„  system  transient  response  can  be  adjusted 
and  ideal  value  found  to  be  0.89.  Adding  the  gain  E,  K  ,  >/  to  the  system  did  not  effect 
the  transient  response.  The  steady  state  response  of  the  system  also  agreed  with  that 
predicted.  It  is  concluded  therefore  that  the  system  transient  response  and  stiffness  arc 
independent,  as  may  be  shown  from  the  complete  transfer  function  (0,  =  consimi)  for  the 
system  in  Figure  32. 


Kt 


Mr  (c.V  -f-  k,X)s  +  k, 


(4.11) 
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Figure  32.  Experimental  Position  Control  System  With  E  =  1  &  K 
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V.  EXPERIMENTAL  STIFFNESS  CONTROL 


A.  NATURAL  STIFFNESS  OF  THE  SYSTEM 

As  presented  in  the  preceding  chapters.  evcr>-  position  control  system  has  its  own 
natural  stiflness.  One  can  feel  the  stifFness  of  the  system  when  the  output  shaft  is  ro¬ 
tated.  When  we  tried  to  rotate  the  output  shaft  of  the  educational  system,  it  was  ob¬ 
served  that  neither  the  output  shaft  nor  the  motor  shaft  rotated.  Therefore,  it  was 
observed  that  the  stilfness  of  the  educational  system  was  infinite.  But  when  we  tried  to 
rotate  the  motor  shaft,  we  fell  the  stiffness  of  the  shaft.  The  stiffness  felt  at  the  motor 
shaft  was  very-  small,  Iherefore,  it  was  not  possible  to  measure  it  by  attaching  a  lever 
arm  to  the  shaft  directly.  The  stiffness  was  not  even  enough  to  lift  the  weight  of  the  lever 
arm.  On  the  other  hand  it  was  enough  to  stretch  a  thin  regular  rubber  band.  Therefore, 
the  stiffness  of  a  DC  motor  shaft  may  be  found  by  using  a  low  force  rubber  band  as  a 
spring. 

B.  STIFFNESS  TEST 

For  this  experiment,  a  regular  rubber  band,  a  protractor,  a  ruler  and  two  different 
weight  units  were  used.  The  rubber  band  was  attached  to  a  fixed  support  where  different 
weights  can  be  applied.  I  hcn  0.25  lb.(0.1134  kg)  unit  applied  to  the  band.  Extended 
length  of  the  band  was  measured  and  it  was  observed  to  be  4.8  in.  (0.12192  m).  When 
0.50  lb.  (0.2268  kg)was  applied,  the  amount  of  stretch  was  6.8  in.  (0.17272  m).  The 
stiffness  curve  (weight  vs  amount  of  stretch)  was  plotted  by  using  these  two  measure¬ 
ment.  The  best  fitting  curve's  slope  gave  the  stiffness  of  the  rubber  band.  The  stiffness 
curve  of  the  band  is  shown  in  Figure  33.  Since,  the  stiffness  of  the  rubber  band  is 
known,  the  amount  of  force  applied  by  using  this  band  may  be  found  from  the  stiffness 
curve  of  the  band  or  by  using  the  following  formula. 
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F=  KX 


(5.1) 


Where,  K  =  The  stiflhess  of  the  band  (the  slope  of  the  stiffness  curve)  and 

X  =  Amount  of  stretch  of  the  band. 

If  the  applied  force  is  known,  torque  may  be  found  by  multiplying  the  force  by  the 
moment  arm. 


T  =  /-Z. 


(5.2) 


Where.  L  =  Moment  arm. 

■fhe  protractor  with  a  small  screw  on  it  was  mounted  to  the  motor  shaft.  1  he  rubber 
band  attached  to  the  screw  and  stretched  ensuring  there  was  9U  degrees  of  angle  be¬ 
tween  the  rubber  band  and  the  moment  arm  as  shown  in  figure  34.  Then,  the  amount 
of  stretch  in  the  rubber  band  length  and  the  rotation  of  the  shaft  was  measured.  1  he 
following  results  were  obtained: 

X  =  5  in.  (0.127  m),  rubber  band  c.xtension. 

L  =1.75  in  (0.0445  m).  moment  arm. 

0„  =  80  degrees  (1.4  radian),  measured  rotation  of  the  motor  shaft. 

F  =  1.226  \  (from  the  curve  using  5  in.  extension),  applied  force.  Then, 


T=  1.226.V  X  0.0445/7t  =  0.055.Vm. 


(5.3) 


So,  the  stiffness  of  the  system  was 


r  _  0.055  .V>n  _  .  Xm 
(>„,  1 .4  raJ  '  rad 


(-5.4) 


MASS(GM) 


Figure  33.  1  lie  Stiffness  Curve  of  (he  Rubber  Band. 


After  the  stifihess  of  tiic  motor  shaft  was  found,  theoretical  value  of  stiffness  was 
calculated  using  the  folloning  equations. 

I  he  stilfncss  of  the  system,  keeping  0,  constant,  with  N'  =  1  and  using  equation 
(4.6),  may  be  written  as 
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Figure  34.  Application  of  the  Rubber  Band  to  the  Motor  Shaft. 


e;^~  R 


Wlicrc,  0,  =  ~^-  I  hen  tlic  siiOncss  oftlic  motor  shaft  will  be 


'^d  ^a^p^poi^T 

RN 


6„  =  Angular  displacement  of  the  motor  shaft. 
The  measured  values  weie 
k,  =  U.48 
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=  0.01  (Nni  '  volt) 
K 

K  =  41 
N  =  30 


rad 


So,  the  stilFness  will  be 


'^d  0.48x41x0.01x5.7  a  a->7  /c  7\ 

0^  ~  30  rad  ’ 

When  equation  (5.7)  and  (5.4)  were  compared,  it  was  observed  that  the  percentage 
error  was  5.4  %.  So,  it  was  concluded  that  the  theoretical  value  of  the  natural  stiflness 
of  the  motor  shaft  matched  with  the  one  found  by  performing  the  rubber  band  test. 

After  finding  the  stilTncss  of  the  motor  shaft,  the  variation  of  the  stiffness  of  the 
system  with  the  feedback  gain  E,  may  be  observed  and  compared  with  the  thcor\ .  The 
stiffness  variation  experiment  may  be  performed  to  observe  the  variation  of  the  stiffness. 

C.  STIFFNESS  VARIATION  EXPERIMENT 

The  disturbance  feedback  system  was  designed  by  using  an  aluminum  lever  arm,  two 
strain  gages,  an  amplifier,  a  protractor,  a  voltmeter  and  weight  units. 

Two  strain  gages  were  mounted  on  the  site  which  is  the  closest  point  on  the  beam, 
to  the  output  shaft,  so  as  to  be  able  to  measure  maximum  strain.  Also  one  strain  gage 
was  mounted  top  side  and  the  other  was  mounted  on  the  other  side  of  the  beam  to  be 
able  to  get  maximum  voltage  as  shown  in  Figure  35. 

The  beam  was  mounted  on  the  output  shaft  as  shown  in  Figure  35.  The  voltage 
obtained  from  two  strain  gages  was  fed  back  to  system  through  an  amplifier.  The 
voltmeter  was  connected  to  the  system  to  be  able  to  measure  and  observe  the  value  of 
the  gain  E.  The  amplifier  provided  us  the  ability  to  vary  the  gain  E.  The  protractor  was 
mounted  on  the  motor  shaft  as  in  the  rubber  band  test.  The  value  of  the  gain  E  was 
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Figure  35.  The  Sliffness  Variatiun  Test. 

changed  by  using  the  amplifier.  After  setting  up  tlic  amplifier  for  certain  values  of  the 
gain  li,  the  beam  wa.s  loaded  with  the  weights  as  shown  in  Figure  35.  Again  the  multi¬ 
plication  of  the  weight  by  the  moment  arm  as  presented  in  equation  (5.3)  gave  the  ap- 
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plied  disturbance  torque.  The  disturbance  torque  was  calculated  for  two  different 
weights.  One  set  of  data  may  be  obtained  by  using  the  following  method. 

The  gain  E  was  adjusted  to  be  2  (volts  Nm).  The  beam  was  loaded  first  with  0.25 
lb.(0.1134  kg),  then  with  0.50  lb.  (0.2268  kg)  respectively.  For  each  load  the  rotation  of 
the  motor  shaft  recorded.  As  can  be  noticed  ,  the  rotation  was  recorded  for  the  motor 
shaft,  not  for  the  output  shaft,  because,  it  was  easier  to  measure  the  rotation  at  this 
point.  Then  the  applied  disturbance  torque  was  plotted  against  the  rotation  of  the  motor 
shaft  for  the  two  measurements  as  shown  in  Figure  36.  fhe  slope  of  the  straight  line 
gave  us  the  stiffness  of  the  system  at  the  motor  shaft.  After  obtaining  necessary  meas¬ 
urements,  the  stiffness  of  the  motor  shaft  is  converted  to  the  stiffness  of  the  system  by 
using  following  formulas. 


The  procedure  may  be  sununarized  as  follows. 


Table  1.  EXPERIMENTAL  DATA. 


Load  Torque, 

Motor  Shaft  Rotation,  9„ 

Strain  gauge  voltage. 

0.228  Nm 

3.157  rad. 

0.456  volt. 

0.456  Nm 

6.6667  rad. 

0.912  volt. 

As  can  be  seen  above 


0.456vo//  _  j  volts 
0.22S.\//i  .\m 


(5.9) 


m  ' 
O' 


Figure  36.  The  Stifriiess  Curve. 


and  from  the  plot  the  slope  was  6.6366  E-2  (Nm  /  rad).  The  stiffness  of  the  motor  shaft 
was 


-^  =  6.6366^-  2x  30  =  2.05-^  (5.10) 

The  above  procedure  was  repeated  for  several  values  of  E,  and  the  corresponding 
stiffness  determined.  1  he  results  are  summarized  in  table  2. 
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Table  2.  EXPERIMENTAL  RESULTS. 


E(voit/Nni) 

Stiffness  (Nin/rad) 

0.045 

6.15 

0.12 

5.625 

1.37 

2.99 

2 

2.05 

3 

1.19 

66 


M.  ADAPTATION  OF  STIFFNESS  CONTROL  TO  FINGER  SYSTEM. 


We  have  proven  experimentally  that  we  can  var\'  the  stiffness  of  a  position  control 
system  by  means  of  the  torque  feedback.  We  now  apply  this  concept  to  our  original  goal 
of  attempting  to  vary  the  stiffness  of  a  single  finger  joint  of  a  robotic  hand  .  The  problem 
is  exactly  the  same  as  the  one  previously  described,  except  that  the  motor  characteristics 
are  difl'erent  and  the  motor  used  in  the  joint  is  smaller.  Therefore,  we  may  control  the 
finger  joint  by  using  the  same  methodology  used  in  the  preceding  chapters.  The  motor 
used  in  this  research  and  its  characteristics  are  shown  in  Figure  37.  Some  of  the  pa¬ 
rameters  may  be  obtain  from  the  catalogue  [Ref  IJ.  These  are  ; 

AV  =  3.2  mNm  A  (0.453  oz-in  A) 

R  =  26  ohm 
J  =  0.03  E-7  kgm^ 

T„  -  1  msec. 

>/  =  0.6 

N  =  362 

10  volts  may  be  considered  as  a  typical  voltage  that  can  be  applied  to  a  motor  in  a 
finger  joint.  If  the  potentiometer  has  270  degrees  of  scale,  then 


,  _  10  volts 

270  degrees 


=  0.037 


volts 

degrees 


=  2.11 


volts 

rad 


(6.1) 


The  value  of  A*  may  be  found  from  the  following  equation: 


T  = 

*  m 


./ 


c  + 


R 


(6.2) 
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Figure  37.  M915L61  Electric  Motor. 


We  can  derive  the  following  equation  from  equation  (3.6),  (3.7),  (3.8). 

=  (6.30) 

Then, 

h^^rir-  (6.36) 

All  values  in  equation  (6.3b)  can  be  obtained  from  the  catalogue.  So, 
k^^3.4SE-3 

rad 

Since,  spur  gears  were  used  in  the  system,  the  system  will  be  backdriveable.  There¬ 
fore,  K  =  1. 

After  finding  the  necessary  parameters,  we  can  simulate  the  system.  The  block  dia¬ 
gram  of  the  system  is  shown  in  Figure  38.  '1  he  only  diflcrence  of  this  system  from  the 
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educational  servo  system  is  A„.  We  don't  need  this  gain  in  the  finger  joint  system,  because 
enough  voltage  can  be  supplied  to  the  motor  directly,  but  A„  can  be  used  in  the  finger 
system  to  obtain  desired  close  loop  time  constant.  To  be  able  to  obtain  an  ideal  transient 
response  without  overshoot  the  forward  path  gain  must  be  0  <  k,  <  106.  The  natural 
stifihess  of  the  system,  where  A,  =  1  will  be 

_  R  _  1.23E-4X  2.11 
_L  0.0016572 

A' 

In  equation  (6.4)  the  value  of  the  natural  stiffness  of  the  system  is  also  given  as  the  in¬ 
verse  of  the  compliance,  because  again  our  simulation  plot  was  the  system  compliance 
vs  time.  As  can  be  seen  from  Figure  39,  the  system  has  no  overshoot.  Therefore,  the 
system  has  ideal  response  and  it  is  suitable  for  our  goal.  The  system  was  also  simulated 
for  different  values  of  the  gain  E  and  it  was  observed  that  the  gain  E  doesn't  elTect  the 
transient  response  of  the  system  as  expected.  The  stilfness  variation  of  the  system  is 
presented  in  Figure  40. 

To  be  able  to  adapt  the  position  control  system  presented  above  to  the  finger  sys¬ 
tem,  the  \1915L6i  electric  motor  was  installed  inside  a  brass  case  before  the  finger  joint 
as  shown  in  Figure  41  and  an  aluminum  beam  was  used  as  a  torque  measurement  sys¬ 
tem. 

One  of  the  most  important  parameter  which  will  decide  the  dimensions  of  the  beam 
for  the  finger  tip  was  the  length  and  the  width  of  the  strain  gages.  The  total  length  was 
therefore  determined  to  1.5  cm  (0.59  in),  and  the  width  was  0.3  cm  (0.1 18  in).  Two  strain 
gauges  for  each  side,  a  total  four  strain  gauges  were  mounted  on  the  beam  to  get  maxi¬ 
mum  voltage.  The  width  of  the  beam  was  decided  to  be  0.95  cm  (  0.375  in),  fhe  maxi- 


1 


rad 


6.385  Nm 


=  0.157 


yni 

rad 


(6.4) 
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compliance 


0 


71 


STIFFNESS  VS  THE  GAIN  E 


E(VOLTS/NM) 


Figure  40.  Variation  of  the  Stiffness  in  tlie  Finger  Joint  System. 
Where, 

Jmi«  =  Maximum  deflection  of  the  beam 
r  =  Applied  force 

1  =  Working  distance  of  tlie  beam,  2.54  cm.  (1  in) 
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E  =  Modulas  of  elasticity,  for  aluminum,  71  Gpa. 

I  =  Moment  of  inertia,  3.167  E-4  cnf. 
b  =  Width  of  the  beam,  0.95  cm  (0.375  in) 
h  =  Thickness  of  the  beam,  0.159  cm.  (0.0625  in) 

A  plot  of  deflection  of  the  beam  for  dilferent  forces  is  presented  in  Figure  42. 

As  can  be  seen  from  the  Figure  41,  the  finger  tip  is  only  attached  to  the  beam  and 
not  to  the  finger  case,  therefore  it  is  free  to  move.  W'hen  the  disturbance  torque  is  ap¬ 
plied  to  the  finger  via  finger  tip,  the  beam  to  which  the  tip  is  attached  will  be  deflected. 
So,  by  feeding  back  the  voltage  obtained  from  the  strain  gauges  to  the  system,  the 
stiffness  of  the  system  may  be  changed  as  presented  in  preceding  chapters. 


DEFLECTION(M) 
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Vll.  DISCUSSION 


A.  MODELING  OF  THE  SYSTEM: 

The  main  goal  of  this  research  was  to  be  able  to  control  the  amount  of  torque  ap¬ 
plied  to  an  object  by  a  robotic  finger  which  was  actuated  by  a  small  electric  motor 
through  a  gearbox.  The  torque  applied  on  an  object  by  the  finger  can  be  changed  by 
vary  ing  the  stiffness  of  the  servomechanism  installed  into  the  finger.  The  stiffness  vari¬ 
ation  ability  can  be  provided  to  the  system  by  feeding  back  the  disturbance  torque 
measured  from  the  object  to  the  system  through  a  variable  gain  E. 

Since  we  are  mainly  interested  in  controlling  the  torque,  the  efficiency  and  the 
backdriveubilty  of  the  gearbox  used  in  the  system  must  be  taken  into  account  when 
modeling  the  system.  As  the  efficiency  increases  the  backdriveablity  will  be  higher,  i.e 
the  system  will  be  more  likely  to  be  backdriveable.  It  is  also  important  to  notice  that  the 
efficiency  of  the  gear  train  does  not  effect  the  actual  transfer  ratio  of  the  gears  in  terms 
of  displacement,  velocity  or  acceleration,  but  greatly  effects  any  torque  related  property. 

Different  types  of  gearboxes  can  be  used  in  a  servomechanism.  Gearboxes  with  high 
gear  ratios  can  be  used  to  increase  the  torque  applied  by  the  output  shaft.  Gearboxes 
with  high  gear  ratios  will  help  disturbance  rejection.  The  effects  discussed  above  must 
be  added  to  the  system  block  diagram  to  obtain  an  accurate  model  of  the  system  in  order 
to  control  the  torque  applied  on  the  object. 

B,  VARIABLE  STIFFNESS  CONTROL: 

After  adding  torque  feedback  to  system,  the  stiffness  of  the  system  will  be  a  func¬ 
tion  of  the  gain  E  and  the  system  will  have  its  natural  stiffness  when  the  gain  E  is  equal 
to  zero.  In  the  nonbackdrivcablc  case,  the  natural  stiffness  of  the  system  will  be  infinite, 
but  this  does  not  mean  that  the  motor  shaft  stiffness  will  be  infinite  also.  As  the  gain  E 
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increases,  the  stlfTness  of  tlie  system  will  decrease  as  shown  in  Figure  43.  As  the  gain 
E  increases,  the  stiffness  decreases,  the  amount  of  rotation  of  the  output  shaft  for  the 
same  amount  of  the  disturbance  torque  measured,  will  be  directly  proportional  to  the 
gain  E.  Namely,  to  be  able  to  obtain  a  higher  rotation  for  the  same  amount  of  the  dis¬ 
turbance  torque,  the  gain  E  must  be  increased. 

The  variation  of  the  stiffness  in  a  servomechanism  was  also  proved  experimentally 
on  a  larger  model.  As  can  be  seen  in  Figure  43,  the  variation  of  the  stiffness  of  the  sys¬ 
tem  measured  experimentally  has  the  same  characteristics  as  predicted  theoretically.  For 
different  values  of  E,  the  stiffness  of  the  system  measured  experimentally  was  lower  than 
the  ones  predicted  theoretically.  The  main  reason  of  this  may  be  the  nonlinearity  that 
exist  in  DC  motors.  Since  we  are  mainly  interested  in  the  stiffness  variation,  the  exper¬ 
imental  data  proves  that  our  prediction  is  correct,  and  that  a  variable  stiffness  servo 
system  can  be  constructed. 

As  presented  before,  the  stiffness  of  the  educational  system  was  infinite,  namely  it 
was  not  possible  to  rotate  the  output  shaft  or  the  motor  shaft  by  applying  a  disturbance 
torque  to  it  due  to  the  nonbackdriveablity  of  the  gearbox.  After  adding  the  torque 
feedback,  it  was  possible  to  achieve  different  stiffness  by  varying  the  value  of  the  gain 
E.  Therefore,  it  is  still  possible  to  vary  the  stiffness  of  the  system  even  when  it  is 
nonbackdriveable. 

Another  parameter  which  effects  the  magnitude  of  the  natural  stiffness  in  a  servo 
system  is  k,  (  forward  path  gain).  As  k„  increases  the  natural  stiffness  of  the  system  will 
increase.  We  didn't  consider  using  for  changing  the  stiffness  of  the  system  because  for 
certain  values  of  k^,  the  system  may  become  unstable.  Since,  k,  also  elTects  the  transient 
response  of  the  system,  after  finding  the  values  of  k,  which  will  give  the  desired  transient 
response  without  overshoot,  by  keeping  the  magnitude  of  k^  in  defined  limits,  the  time 
constant  of  the  system  can  be  changed  to  a  certain  value.  It  was  also  observed  that 
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STIFFNESS(NM/RAD; 


STIFFNESS(NONBACKDRIVABLE) 


Figure  43.  Comparison  of  'Mieoretical  and  Experimental  Stiffness  Variation 


adding  the  torque  feedback  to  the  system  will  not  effect  the  transient  response  o, 


system. 


C.  APPLICATION  TO  ROBOTIC  FINGER  SYSTEM: 

Adaptation  of  the  theorj'  of  variable  stiffness  to  the  finger  joint  was  another  im¬ 
portant  part  of  the  research.  Since  the  finger  joint  is  not  a  large  end  effector,  the  design 
of  the  torque  measurement  system  must  have  certain  size  constraints.  However,  the 
problem  was  exactly  the  same  as  the  one  described  in  the  large  model  analysis.  1  hcre- 
fore,  by  using  the  same  block  diagram  and  obtaining  certain  parameters  from  the  catalog 
and  from  related  equations,  the  variable  stiffness  system  can  be  adapted  to  a  robotic 
finger  joint. 

One  of  the  main  differences  between  the  model  used  for  experiments  and  the  finger 
system  was  the  dimensions  of  the  beam.  The  beam,  on  which  the  strain  gauges  were 
mounted  required  careful  design.  Since  a  small  beam  was  used  in  the  design,  to  be  able 
to  get  higher  voltage,  four  small  strain  gauges  were  used.  The  size  of  the  strain  gauges 
was  one  of  the  main  parameters  which  has  an  important  effect  on  the  design  of  the 
beam. 
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VIII.  CONCLUSIONS 


1.  The  torque  applied  by  an  end  elTector  to  an  object  can  be  controlled  by  changing 
the  stiffness  of  the  servomechanism. 

2.  Certain  parameters  must  be  added  to  the  system  block  diagram  to  obtain  an  ac¬ 
curate  model  of  the  system  in  order  to  control  the  torque  applied  on  the  object. 

3.  After  adding  the  torque  feedback  to  the  system,  the  stiffness  of  the  system  will 
be  a  function  of  the  feedback  gain,  while  adding  the  torque  feedback  does  not  effect  the 
system  transient  response. 

4.  Even  if  the  gearbox  is  nonbackdriveable,  variable  stiffness  control  of  the 
servomechanism  is  possible. 

5.  The  variable  stifl'ness  concept  may  be  easily  applied  to  the  design  of  a  robotic 
finger  tip. 
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APPENDIX  A. 


ME3802  LABORATORY  EXPERIMENT  2  DC  SERVO 


SYSTEM-SPEED  CONTROL 

A.  OBJECTIVES 

The  purpose  of  this  experiment  is  to; 

1.  Become  familiar  with  the  components  of  an  electro-mechanical  speed  control 
system 

2.  Use  basic  measurement  equipment  to  perform  experiments 

3.  Measure  the  transfer  functions  of  the  components  of  the  speed  control  system 
A.  Perform  a  close  loop  speed  control  test  of  the  system 

B.  EQUIPMENT: 

For  this  experiment. you  will  need  the  following  equipment 

1.  Feedback  educational  servo  system  type  ES151 

2.  Dual  trace  oscilloscope 

3.  Digital  voltmeter 

4.  Chart  recorder 

5. A  stop  watch 

6.  Miscellaneous  leads,  wires  and  connectors 

Examine  and  familiarize  yourself  witli  the  equipment,  and  determine  how  to  operate 
and  connect  the  various  pieces  together. 

C.  METHOD 

1.  Compare  the  close  loop  feedback  control  system  shown  in  Figure  44  and 
Figure  45  with  the  schematic  shown  on  the  front  panel  of  the  servo  system. 
Figure  46.  Figure  44  shows  the  complete  schematic,  while  Figure  45  shows  only  those 
parts  that  will  be  used  in  the  experiment  2.  Be  sure  to  identify  the  correspondence  be¬ 
tween  all  elements  in  both  systems.  Note  the  availability  of  certain  system  signals  at  the 
bottom  of  the  front  panel. 

2.  1  he  first  part  of  the  experiment  deals  with  the  identification  of  the  various  pa¬ 
rameters  shown  in  Figure  45.  Connect  the  system  as  shown  in  Figure  47,  making  sure 
the  INTERN.AL  COMPENSATION  switch  is  IN.  Switch  on,  set  input  potentiometer 
0,  to  zero  and  use  the  SERVO  A.MPLIFIER  and  OPERATIONAL  AMPLIMER  SET 
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Figure  4-4.  Position  Control  System  Block  liingrain 

ZliRO  controls  to  achieve  no  motor  rotation  with  minimum  motor  current  shown  on  the 
panel  meter.  Ensure  that  the  FEEDBACK  SELEC  TOR  switch  is  fully  anti-clockwise. 

3,  lachometcr  Con.stant  /<, 

In  this  test,  the  output  voltage  from  the  tachometer  is  rccorilcd  for  various  speeds. 
The  slojie  o(  the  line  of  voltage  plotted  against  speed  then  gives  the  tachometer  constant 
in  volts; Rl’M.  Connect  the  system  as  show-n  in  Figure  47,  and  set  PI  to  1  and  P2  to  1. 
With  the  digital  volt  meter  connected  as  shown,  turn  the  input  potentiometer  to  obtain 
constant  speed  of  rotation  of  the  motor.  Using  a  stop  watch,  record  the  time  for  a  given 
number  of  revelations  (say  2.5).  Note  that  the  tachometer  is  mounted  on  the  motor 
shuTl,  before  the  30:1  gearbo.K  driving  the  output  potentiometer.  Take  this  in  to  account 
when  calculating  the  speed  of  the  tachometer  shaft.  Change  the  setting  of  input 
potcjjtiomctcr  and  repeat  tlic  lest  to  obtain  a  total  of  live  readings.  Plot  voltage  against 
speed,  draw  the  best  straight  line  you  can  and  calculate  the  slope.  1  he  expected  result 
should  be  about  0.0024.5  volts; RPiVI. 


Figure  45.  Open  Loop  Speed  Control  Block  Diagram 

4.  Potentiometer  Constant 

Connect  tlic  apparatus  as  shown  in  Figure  48,  noting  that  the  system  is  open  loop. 
In  this  test  we  will  determine  the  potentiometer  constant  i.e.  the  relationship  between  the 
angular  rotation  of  the  potentiometer  and  the  resulting  voltage  generated.  Note  that 
both  input  and  output  potentiometers  are  identical.  Set  the  input  potentiometer  to  point 
to  zero  degrees  and  record  the  error  voltage.  Rotate  the  input  potentiometer  from  zero 
to  120  degrees  in  20  degree  steps.  For  each  step  record  the  voltage  and  subtract  the 
voltage  corresponding  to  zero  degree  position.  Plot  voltage  against  angular  position  and 
from  the  slope  of  the  best  straight  line  that  fits  the  data  determine  The  expected  re¬ 
sult  should  be  in  the  region  of  5.7  volt/radian. 

5.  Motor  &  Servo  Gain  K, 

This  parameter  is  defined  as  the  ratio  of  the  output  speed  of  the  motor  divided  by 
the  input  voltage  to  the  servo  amplifier.  Connect  the  system  as  shown  in  Figure  49,  with 
P2  set  to  0.7,  and  use  the  input  potentiometer  to  establish  a  constant  speed  of  the  motor 


shaft.  Use  tlie  digital  voltmeter  to  measure  the  input  voltage  to  the  servo  amplifier  and 
record  this  value.  Determine  the  motor  speed  by  connecting  the  digital  voltmeter  to  the 
VELOCITY  socket,  record  the  voltage  and  use  the  previously  calculated  value  of 
tachometer  constant  k,  to  calculate  the  speed  of  the  motor.  Adjust  the  input 
potentiometer  to  give  a  difTercnt  speed  and  repeat  the  test  for  five  data  points.  Plot 
motor  speed  against  input  voltage  and  from  the  best  straight  line  through  the  data  points 
determine  K,.  The  expected  value  is  about  270  radians  sec  per  volt. 

O.Motor  Time  Constant  7„ 

In  this  test,  the  system  is  connected  as  an  open  loop  speed  control  system,  as  shown 
in.  Figure  50  subject  to  a  step  input.  The  step  input  is  obtained  from  a  function  gener¬ 
ator  which  should  be  set  to  provide  a  square  wave  output  with  a  frequency  of  about  0.1 
Hz,  corresponding  to  a  step  input  every  5  seconds.  Set  P2  to  0.2.  To  avoid  using  exces¬ 
sive  record  paper,  use  the  oscilloscope  to  observe  the  output  speed  and  to  qualitatively 
verify  the  response.  The  output  should  look  similar  to  that  shown  in  Figure  51.  The 
purpose  of  the  experiment  is  to  determine  the  time  constant  of  the  exponential  increase 
in  motor  speed  in  response  to  the  step  change  in  demanded  speed.  Once  a  trace  similar 
to  that  shown  in  Figure  51  is  observed,  obtain  a  copy  on  the  chart  recorder  by  switch¬ 
ing  it  on,  adjusting  the  sensitivity,  and  recording  a  few  input  responses.  Make  a  note  of 
the  time  base  for  the  chart  recorder.  The  time  constant  is  calculated  by  determining  the 
time  taken  for  the  system  to  achieve  63%  of  the  demanded  output,  as  shown  in 
Figure  52.  .Measure  the  time  constant  from  at  least  3  response  curve  and  calculate  the 
average  value.  The  expected  time  constant  is  T„  =  O.25seconds. 

7.  Connect  the  system  as  a  close  loop  feedback  control  system  as  shown  in 
Figure  53.  Set  PI  to  1.  All  parameters  shown  in  Figure  44  on  page  SI  are  now  known 
except  for  the  gain  k^.  For  the  servo  system  this  gain  is  actually  the  product  of  the  op¬ 
erational  amplifier  gain  and  the  value  of  the  potentiometer  P2.  Note  that  P2,  being  a 
potentiometer,  is  actually  an  attenuator  and  hence  its  gain  components  must  be  less  than 
unity.  When  socket  B  is  connected  to  socket  E,  the  gain  of  the  operational  amplifier  is 
1,  while  connecting  B  to  F  reduces  the  gain  to  0.1.  Set  P2  to  1  and  perform  a  close  loop 
step  response  as  described  in  the  previous  section  for  the  open  loop.  Observe  the  results 
on  the  oscilloscope,  and  make  a  sample  chart  recording  output  to  determine  the  time 
constant  the  closed  loop  system.  By  analyzing  the  close  loop  transfer  function  together 
with  the  experimental  values  obtained,  calculate  a  theoretical  time  constant  for  the  close 
loop  step  response,  and  compare  it  with  the  measured  values. 
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Figure  46.  Equipment  Conriguration 


Figure  47.  Equipment  Cunfiguration 


Figure  48.  Equipment  Conriguratioii 
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Figure  49.  Equipment  Conflguration 


Figure  50.  Equipment  Configuration 
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